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Summary 

Avionic systems that depend on digitized terrain elevation 
data for guidance generation or navigational reference 
require accurate absolute and relative distance measure- 
ments to the terrain, especially as they approach lower 
altitudes. This is particularly exacting in low-altitude 
helicopter missions, where aggressive terrain hugging 
maneuvering create minimal horizontal and vertical 
clearances and demand precise terrain positioning. Sole 
reliance on airborne precision navigation and stored 
terrain elevation data for above-ground-level (AGL) 
positioning severely limits the operational altitude of such 
systems. A Kalman filter is presented which blends radar 
altimeter returns, precision navigation, and stored terrain 
elevation data for AGL positioning. The filter is evaluated 
using low-altitude helicopter flight test data acquired over 
moderately rugged terrain. The proposed Kalman filter is 
found to remove large disparities in predicted AGL 
altitude (i.e., from airborne navigation and terrain eleva- 
tion data) in the presence of measurement anomalies and 
dropouts. Previous work suggested a minimum clearance 
altitude of 220 ft AGL for a near-terrain guidance system; 
integration of a radar altimeter allows for operation of that 
system below 50 ft, subject to obstacle-avoidance 
limitations. 

Introduction 

Numerous avionic systems employ a terrain elevation 
database for navigation or guidance. Terrain referenced 
navigation systems, such as SITAN (Sandia Inertial 
Terrain- Aided Navigation) or TERPROM (TERrain 
PROfile Matching), utilize radar altimeter returns, a 
terrain elevation database, and a control filter to calculate 
corrections to the aircraft’s inertial navigation system 
(INS). This is accomplished by correlating terrain profiles 
from a radar altimeter with candidate digital map terrain 
profiles in the surrounding area, and selecting the most 
similar digital map profile in obtaining horizontal position 
(refs. 1-3). Stored terrain data have also been used in 
trajectory and guidance generation. Applications range 
from simple straight-line terrain following between 
waypoints to sophisticated “ground-hugging” meandering 
flight (ref. 4). 

Digital terrain elevation database-dependent avionics are 
operationally constrained due to navigation and terrain 
database inaccuracies. As lower altitudes are approached 
and more aggressive maneuvering attempted, the ability 
of the aircraft to reliably and accurately position itself 
relative to the ground becomes vital. Unrecorded features 
and map horizontal shifts have been observed in flight 
tests (ref. 5). Persistent above-ground-level (AGL) bias 


due to navigation and terrain map errors must be 
identified and accounted for, in addition to higher 
frequency terrain features unrepresented in the stored 
terrain database. 

A low-level, maneuvering terrain following/terrain 
avoidance (TF/TA) guidance system for helicopters has 
been under development at NASA Ames Research Center 
(ref. 6). The guidance algorithm uses mission require- 
ments, aircraft performance capabilities, navigation data, 
and digitized terrain elevation data to generate a low- 
altitude, valley-seeking trajectory. This trajectory is 
generated in real-time and presented to the pilot on a 
helmet-mounted display. The system’s flight envelope is 
principally limited in its ability to position itself within 
the terrain, and its inability to detect and avoid unmapped 
obstacles, such as trees and wires. After evaluation in 
several full-motion, piloted simulations, the system has 
reached sufficient maturity for flight evaluation. A joint 
NASA/Army program to flight test the system on the U.S. 
Army NUH-60 STAR (Systems Testbed for Avionics 
Research) helicopter is scheduled for spring 1992. 

An appraisal of the digital terrain map prior to flight 
evaluation was conducted to establish a minimum 
clearance altitude during flight tests (ref. 7). This was 
accomplished by comparing predicted terrain elevation 
database values based on measured horizontal position 
with elevation obtained by taking the difference between 
measured navigational vertical position and radar altitude. 
Precision navigation (from a ground-station improved 
Global Positioning System (GPS) receiver) and radar 
altimeter returns were recorded as a test aircraft flew 
low-altitude missions over rugged and plain areas. The 
combined navigation and database errors in terrain eleva- 
tion were found to be as great as 220 ft, establishing a 
minimum clearance altitude for flight test of 220 ft AGL. 

To improve AGL positioning of the NASA/Army terrain 
database dependent guidance system, a Kalman filter 
which augments this system through the integration of a 
radar altimeter is developed. Radar altimeter measure- 
ments are blended with inertial navigation system vertical 
position and stored digital terrain data to provide a more 
accurate estimate of altitude AGL than that based solely 
on airborne navigation and terrain elevation data. The 
estimate is also more robust and stable than that provided 
by a radar altimeter alone. The linear, sequential measure- 
ment processing Kalman filter presented is found to 
essentially remove the AGL positioning limitation of the 
aforementioned guidance system, leaving only the flight 
envelope constraint imposed by obstacle detection and 
avoidance. 



The paper begins with the problem formulation and 
system description. State models are then developed and 
the Kalman filter cast. Filter performance is appraised 
using helicopter flight data acquired over moderately 
rugged terrain, and concluding remarks are then given. 

Problem Formulation 

Figure 1 describes key variables and definitions involved 
in the low-altitude, digital terrain map referenced flight 
environment. 



The aircraft is depicted on a nominal flight path with 
altitude above-ground-level denoted as h , Navigational 
mean-sea-level (MSL) altitude is denoted as h ms [, and 
sampled terrain elevation data as h^ ma . The difference in 
these two values is the “predicted” AGL altitude, the 
current method of determining height above ground. The 
radar altimeter measurement for AGL altitude is repre- 
sented as h ra d. This measurement, along with the pre- 
dicted measurement of AGL altitude, is to be blended to 
yield an improved estimate of h . 

A block diagram of the integrated system is shown in 
figure 2. 



Figure 2. System block diagram. 


There are two inputs to, and two outputs from, the 
Kalman filter. The first input, the predicted AGL altitude, 
hpred ~ K msl “ hdma* has multiple error sources. Regard- 
less of the navigation system employed, h ms i will contain 
some error. GPS would provide the most accurate and 
reliable positioning solution. The civilian Coarse Acqui - 
sition code (C/A-code) of GPS gives positioning accuracy 
of 20-40 m (66-131 ft), degrading to 100 m (328 ft) when 
Selective Availability is activated. The military Precision 
code (P-code) yields 10-20 m (33-66 ft) positioning 
accuracy. Differential GPS yields 2-3 m (7-10 ft) 
positioning accuracy (ref. 8). 

The accessed value for terrain elevation, h is an 
imperfect approximation of the terrain, and is referenced 
using the imperfect latitude-longitude output from the 
navigation system. A Level 1 Defense Mapping Agency 
(DMA) Digital Terrain Elevation Data (DTED) database 
consists of a uniform matrix of MSL terrain elevation 
values. These database values have an “acquracy objec- 
tive” of 30 m (98 ft) at 90% linear error for absolute 
vertical elevation, and 130 m (427 ft) at 90% circular 
error for absolute horizontal position. Each 1 deg by 1 deg 
latitude-longitude cell carries its own accuracy specifica- 
tions, however, which depend on the data collection 
method used for that area, and can be greater than the 
general database accuracy objectives. Because the terrain 
elevation stored in the DMA database is accessed through 
the latitude-longitude value of the navigation system, 
horizontal positioning errors will reference offset terrain 
data. The sum of this h^ ma error, combined with those of 
the navigation system, can lead to large errors in the 
predicted absolute AGL altitude, although relative, lower 
frequency AGL altitude movement will be fairly accurate 
and reliable. 

The second input to the Kalman filter of figure 2 is the 
radar altimeter, a direct measurement of the above- 
ground-level altitude. Typical radar altimeters are limited 
in operational altitude and degrade in accuracy with 
altitude. Most are fan-type, i.e., a conical beam is 
transmitted, and height above ground or nearest obstacle 
is returned. The measurement is thus relatively insensitive 
to aircraft roll and pitch attitude, and returns height above 
the nearest terrain feature. The spreading of the radar 
beam “footprint,” however, can yield radar altimeter 
returns registered from nearby higher terrain, rather than 
that directly below the aircraft. Flight over a dense forest 
will yield height above the treetops (canopy height), while 
flight over bare (winter) trees will give height above the 
ground (refs. 9 and 10). 

These two measurements are then blended in a Kalman 
filter to yield an improved estimated value for AGL 
altitude, h t . As a by-product, the error between this 
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AGL estimate and the predicted AGL value, i.e., 
h err = hpred ~ K also be produced. 


State Models 


Two states variables are defined: 


x\ = h 

a) 

x 2 ~ herr = hpred ~ h 

(2) 


The first state is the AGL altitude, and the second is the 
time-varying bias error between the first state and the 
predicted (navigation/terrain database) AGL altitude. 

The first state is modeled as a random walk: 

*1 = (3) 


with white noise inputs of w 2 ~ aJo,G 2 j and 
W3 ~ ^[ 0 , 0 ^ J. The standard deviations for both W2 and 
h >3 were set at 10 ft/sec. Such a slope-intercept model 
naturally leads to an additional state variable. Physically, 
this model may more accurately represent the h err state 
over dense foliage contained in a valley. In this situation, 
the radar altimeter would typically return height above the 
treetops. Because trees commonly grow to a uniform 
altitude in a valley, while a DMA terrain elevation 
database stores height of the valley floor, a ramp model 
for the AGL altitude error seems reasonable. (Consider an 
aircraft flying at constant MSL altitude: its radar altimeter 
would measure a constant AGL altitude to the treetops, 
while the navigation/terrain database hp re d would register 
the sloping valley floor.) 
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where w\ is white noise of zero mean and variance Op 
i.e., w\ ~ jv|o,o^j. The white noise standard deviation 
was set to 20 ft/sec. Physically, this describes a system 
driven by white noise. This rather simplistic model was 
taken due to this state’s strong dependence on flight 
profile. The AGL altitude signal would be quite different 
for an aircraft flying a low-level (constant MSL) mission 
over hilly terrain versus a contour (constant AGL) flight 
over the same area. Terrain characteristics (flat versus 
mountainous) would also generate different AGL altitude 
traces. More sophisticated, perhaps mission dependent 
AGL altitude state models could be considered in future 
work. 

Two models for the second state h err will be considered. 
The first model is that of a first-order Gauss-Markov 
process described by: 

*2 = — P x 2 + i/2a jP H’2 (4) 

where 1/(3 is the process time constant and u>2 is white 
noise of w 2 - A^G^j. A Gauss-Markov process is a 
stationary Gaussian process (all probability density 
functions are normal) with an exponential autocorrelation 
of ZT[;t 2 (f).x 2 (f + T )] = 02 e ~^‘ Th is presents a slowly 
varying model for the coupled navigational and terrain 
database errors. Spectral analysis of flight data established 
1/(3 at 10 sec and G 2 at 45 ft/sec. Note that a 1/(3 of 10 sec 
corresponds to an along-track distance of — 1/4 mile for an 
aircraft flying at 90 kts. 

An alternative model for the h err state is that of a 
random-ramp process described by: 


x 2 =x 3 + H’2 

(5) 

x 3 = w 3 

(6) 


Finally, the two measurements are defined as: 

^1 = hmsl ~~ hdma 

= *1 + *2 v ! (7) 

Z2 = hrad 

= *1 + v 2 (8) 


where the instrument errors v [ and vj are Gaussian white 


The standard 


noise of vj ~ |o,G^j and v 2 ~ J^0 ,g 
deviations were set at 10 ft/sec and 20 ft/sec for v\ and v 2 , 
respectively. 


It should be noted that the state equations are attempting 
to model AGL altitude given two measurement sources 
with distinctly different characteristics. The first measure- 
ment, h ms i - hd ma , will give good relative height-above- 
ground information. This measurement is expected to be 
quite smooth and reliable, although it will carry a bias due 
to both the navigation vertical position solution and the 
stored DMA map. The radar altimeter complements the 
navigation/terrain database measurement in registering 
higher frequency absolute height-above-ground move- 
ments. This measurement, however, will be somewhat 
noisy and of higher variance than measurement one. The 
Kalman filter serves to blend these two measurements 
in producing a more stable, responsive, and accurate 
estimate of AGL altitude. 


The explicit separation of the by-product h €rr in the state 
equations allows for flexibility in planned flight test 
implementation of the filter. Both filter outputs of AGL 
altitude and the difference in AGL altitude (between this 
estimate and that based on navigation/terrain database) are 
thus readily available. 

These linear state models are now written in discrete-time, 
state-space form for each of the two models for the second 
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state h err . Using the Gauss-Markov model for h ern one 
obtains 
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where e £ = -X£ is the estimation error, and is the 

estimated value of a* based on all measurements up to, but 
not including, those at step time fy. 

Statistical properties of the white noise sequences >v£ and 
are defined by the covariance matrices 


Qk= E \ w k w l] 

(16) 

II 

£ 

(17) 


Similarly, the alternative random-ramp state model for 
h err yields the state equation: 
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and measurement 


V 



k - 


1 0 
0 0 


*1 

x 2 

x 3 


v \ 

Vo 


( 12 ) 




Kalman Filter 

The discrete-time Kalman filter is a recursive optimal 
control filter most appropriate for estimating a noisy 
signal given noisy measurements. The Kalman optimal 
criterion is the minimization of mean-square error. The 
gains which satisfy this criterion are computed for each 
measurement sample. These gains take into account prior 
performance of measurements and states, in addition to a 
priori statistical knowledge of the random processes 
present. The filter is formulated using the notation of 
Brown (ref. 1 1), State and measurement equations are 
written as: 

-**+1 =®k x k +(i >k (13) 

z k = H k x k +v k (14) 

where <t>k the state transition matrix, H k is the observa- 
tion matrix, and and are uncorrelated white noise. 

The updating of the state equations for given measure- 
ments is accomplished by constantly computing the error 
covariance matrix 

p k- E [ e k e I] (15) 


The state and measurement white noise disturbances are 
uncorrelated, i.e., j = 0 for all k and i. 

After initial values x 0 , P 0 for the states and error covari- 
ance are established, the recursive Kalman filter equations 
are: 



(18) 

x k =x k +K k [z k -H k xi\ 

(19) 

p k =[ l ~K k H k ]P k 

(20) 


where K k is the Kalman gain matrix, x £ is the updated 
state estimate given measurements through zk, and Pk is 
the updated error covariance matrix. The initial state 
values, x a> were set with respect to the first measurements 
received, equivalent to setting the elements of P 0 at 
infinity. 

The state and error covariance matrices are projected 
ahead to the next time step as: 

(21) 

Pk + \=^kPk^ T k+Qk ( 22 ) 

In actual operation where time steps are asynchronous, 
these projections occur upon receipt of the measurements, 
to allow the actual time increment to be used. 

The Kalman filter is implemented to process the 
measurements sequentially, an established procedure 
(refs. 12 and 13) which allows a measurement rejection 
test to be applied. The structure of the filter matrix 
equations (18)-(22) remains unchanged, but the measure- 
ment matrix Hk becomes a row vector and the measure- 
ment covariance matrix Rk becomes a scalar correspond- 
ing to the scalar measurement zk being processed. 

The rejection test compares each measurement with that 
predicted from the measurement model 

Zk = h k*k ( 23 ) 
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whereby a measurement deemed statistically unreasonable 
is thrown out and not used to update the state and error 
covariance matrices. The measurement residual 

Pk=Zk~Zk (24) 

is compared with the expected standard deviation of that 
measurement 

~ ( 25 ) 

in determining acceptance of a measurement. 

In this work, a two standard deviation (2a\) criterion was 
established for pj (residual from navigation/terrain data- 
base predicted AGL altitude measurement) and a 4ot2 
criterion for p 2 (radar altimeter measurement residual). 
Thus, if pi exceeded 2<X\ , or if P 2 was greater than 4ct2 , 
that measurement was discarded. These thresholds were 
set based on the behavior of the instruments used in 
acquiring the flight test data considered in this report, and 
reflect a greater confidence in the radar altimeter mea- 
surement than the navigation/terrain database measure- 
ment. Such rejection limits would have to be adjusted for 
different measurement sources than those considered here, 
and possibly for flight conditions (e.g., poor GPS satellite 
navigation data due to satellite geometry or intermittent 
reception). 

Finally, for numerical stability the symmetric error 
covariance matrix P £ was forced to remain symmetric 
after every measurement update by averaging the off- 
diagonal elements. Divergence of a Kalman filter without 
such a constraint is well documented (refs. 1 1 and 12). 

Test Procedure 

The performance of the Kalman filter is assessed using 
low-altitude helicopter flight test data. Both models for 
the second state h err are considered, allowing a direct 
comparison of their relative performance to be made. 
Inputs required are aircraft position (MSL altitude, 
latitude, longitude) from a navigation system, radar 
altimeter return, and digital terrain elevation data. 

The flight test data were acquired by the U.S. Army 
Avionics Research and Development Activity 
(AVRADA) in support of the terrain-referenced naviga- 
tion research of Hollowell (ref. 3) during fall 1989. The 
same data were employed in this author’s earlier work 
(ref. 7) on digital terrain elevation data, which describes 
the flight characteristics and instruments in greater detail 
than are given here. Low-altitude helicopter flights were 


conducted in a UH-1 (Huey) helicopter in south-central 
Pennsylvania, just south of Harrisburg. The moderately 
rough terrain varied from flat plain sections through 
mountainous regions containing regions of dense 
deciduous trees. The aircraft flew at a constant ~90 kts. 

Airborne data recorded at 1 Hz included 4-channel C/A 
code GPS navigation (Motorola Eagle Mini-Ranger), with 
specified 25 m (82 ft) positioning accuracy. Selected 
availability, the intentional degradation of the GPS signal, 
was not activated. A nearby ground station, at a known 
surveyed site with an identical GPS receiver, provided 
differential GPS (DGPS) bias corrections. These correc- 
tions were applied during postprocessing to the airborne 
GPS navigation solution for improved helicopter 
positioning. Such a procedure requires the ground and 
airborne receivers to be tracking the same constellation of 
satellites. The positional DGPS procedure employed 
operates with the positional solution of the ground 
receiver, rather than the more common DGPS technique 
that uses raw pseudo-ranges received from the satellites 
(ref. 8). 

Radar altimeter data were recorded at 1 Hz. The fan-type 
radio-frequency altimeter (Honeywell APN-209) returned 
aircraft height above ground or closest terrain obstacle to 
altitudes of 1 500 ft, and through pitch and roll angles of 
45 deg. Flight over dense foliage typically results in 
height above the foliage canopy top, while flight over bare 
trees gives height above the ground itself. Radar altimeter 
accuracy was specified to be 3 ft + 3% of actual altitude 
(refs. 9 and 10). 

The terrain elevation database employed was Level 1 
DMA DTED in the 1 deg by 1 deg ceil from 77 deg to 
78 deg west longitude and from 40 deg to 41 deg north 
latitude. The database carried accuracy specifications of 
260 m (853 ft) in absolute horizontal position and 50 m 
(164 ft) in absolute vertical elevation, both at 90% 
confidence level. The database prediction of terrain 
elevation is found by forming a triangular plane of the 
nearest three “posts” of DMA data. The interpolated value 
of this plane below the aircraft is taken as the database 
elevation prediction. 

Results and Discussion 

The Kalman filter estimate of AGL altitude, /? r , is shown 
in figure 3 for a typical section of flight data. During this 
period, the helicopter was maintaining a constant MSL 
altitude of -1000 ft, over terrain ranging from 300 ft to 
700 ft MSL. 
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The two measurements are also shown in figure 3. The 
abscissa represents a downrange distance of ~5.5 n. mi., 
corresponding to an aircraft speed of ~90 kts. Despite the 
coupled measurement model ( H non-diagonal in eqs. (10) 
and (12)), the estimate h t was essentially the same for the 
two h err models of equations (4)-(6). Hence, only one of 
the estimates for h t is given in figure 3. 

The amount of error contained in an AGL altitude 
computed from on-board navigation and stored terrain 
elevation data (i.e., measurement z\) is striking when 
compared with the AGL altitude sensed by the radar 
altimeter {z 2 ). For instance, at time 25 sec the predicted 
AGL altitude (cj ) puts the aircraft’s AGL altitude at 
413 ft, whereas the radar altimeter puts it at 513 ft. Such 
a 1 10 ft disparity in these two measurements clearly 
illustrates the need for improvement to an AGL altitude 
determined solely from airborne navigation and a stored 
terrain map. 

Sections of flight data dropout are evident during the 
period shown in figure 3. Ar time 12 sec for 10 sec and 
again at time 65 sec for 7 sec there were no navigational 


or radar altimeter data recorded. During these periods, the 
state estimate is dictated by the state transition matrix 
of equation (13). State propagation is based on the last 
updates of the error covariance P £ and associated Kalman 
gains, Kfr. The constant^ value during these periods is a 
consequence of the random walk model for h t . 

The effect of the rejection test implemented in the 
sequential measurement processing Kalman filter is 
evident in figure 3. Just prior to the data dropouts 
mentioned, erroneous navigation MSL data were 
generated by the GPS receiver, namely at times 12 sec 
and 65 sec. At these locations the navigation vertical 
solution was deemed unreasonable and dismissed, i.e., the 
measurement residual of equation (25) exceeded the twice 
standard deviation criterion set for z \ . The filter did not 
update the state, error covariance, and gain matrices with 
these measurements. Possible explanations for these GPS 
“wild points” would include GPS signal multi-pathing, 
antenna blockage, or receiver queries for better satellite 
constellations. The radar altimeter measurement did fall 
within its established acceptance limits at these points, 
however, and was used for updating. 



6 




V 



Time (sec) 

Figure 4. Filter AGL altitude error output. 


The filtered estimate of h err over the same section of 
flight test data is shown as figure 4. 

The difference in the two measurements, z\ -z% is plotted 
with the filter estimate h err . The output for each of the 
two mathematical state models for h err is shown. Recall 
the data discussed at time 25 sec in figure 3, which indi- 
cated a predicted AGL altitude z\ of 413 ft and radar 
altimeter AGL Z2 of 523 ft. These data are reflected in 
figure 4 where z\ - Z2 is -0 ft for time 25 sec. 

The performance of the Kalman filter in estimating h err 
for each of the two state models is about the same, except 
for their marked difference during measurement dropouts. 
During these periods (time 12 to 22 sec, and time 65 to 
73 sec) the fundamental difference between the Gauss- 
Markov and random-ramp model is apparent. The Gauss- 
Markov model of equation (9) yields an exponentially 
decaying h err value in the absence of additional mea- 
surements. The random ramp model in equation (1 1), 
however, projects a ramp function. As such, the more 
stable Gauss-Markov model for the state h err is preferred. 

Both state models for the AGL error (h err ) rejected the 
same erroneous predicted AGL altitude measurements 
(zj) referred to earlier. Differences between estimated 
state h err and the measurement of h err = z\ - Z2 never 
exceeded 50 ft during this and the additional 90 min of 


flight data analyzed. The filtered estimate of true AGL 
altitude h t could be used directly for AGL positioning in 
an exclusively navigation/terrain map-based system, or 
the by-product state h err could be added to the existing 
system’s predicted AGL altitude. 

The figures presented are representative of the kind of 
accuracy, responsiveness, stability, and robustness of the 
filter for the helicopter flight test data considered. 

Concluding Remarks 

1) A Kalman filter for the integration of a radar 
altimeter into a terrain database-dependent guidance 
system has been developed. The filter’s performance was 
analyzed using low-altitude helicopter flight test data 
acquired over moderately rugged terrain. The two-state 
Kalman filter is stable, responsive, and accurate in 
estimating both the aircraft above-ground-level (AGL) 
altitude, and the by-product AGL altitude difference error, 
present in the existing terrain-based system. 

2) The sequential measurement processing Kalman filter 
performs well in the presence of measurement anomalies 
and data dropouts. An input data rejection test has been 
implemented which successfully identifies and disregards 
erroneous data based on statistical criteria. 
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3) The radar altimeter augmented near-terrain system 
allows for reduced minimum clearance altitude operation 
to approximately 50 ft, subject to obstacle avoidance 
limitations. Without the radar altimeter integration, terrain 
database and navigational errors restricted operation to 
220 ft. Flight is now limited as a function of pathway 
obstacles, e.g., trees and wires, which would have to be 
identified by a forward-looking sensor. 

The NASA/Army near-terrain guidance system, with the 
proposed radar altimeter integration, is scheduled for 
flight evaluation during spring 1992. A forward-looking 
sensor for obstacle detection and avoidance will even- 
tually be incorporated as nap-of-the-earth operation is 
approached. 

The author would like to thank Ray Clark et al. (U.S. 
Army AVRADA) for providing the flight test data and 
documentation. 
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